cited in the European Search 

Report of EP&+CO 

Your Ref.: Q-fZSfZ-OZ.^ 



(19) 



J 



Europaisches Patentamt 
European Patent Office 
Office europeen des brevets 



(12) 



(43) Date of publication: 

23.05.2001 Bulletin 2001/21 

(21) Application number: 00309496.8 

(22) Date of filing: 27.10.2000 



( ii) EP 1 102 397 A2 

EUROPEAN PATENT APPLICATION 

(51) mtci7: H03H 17/02 



(84) Designated Contracting States: 


(72) 


Inventor: Syrjarinne, Jarl 


AT BE CH CY DE DK ES Fl FR GB GR IE IT LI LU 




33500 Tampere (Fl) 


MC NL PT SE 






Designated Extension States: 


(74) 


Representative: Read, Matthew Charles etal 


AL LT LV MK RO SI 




Venner Shipley & Co. 






20 Little Britain 


(30) Priority: 22.11.1999 US 444584 




London EC1A 7DH (GB) 


(71) Applicant: NOKIA MOBILE PHONES LTD. 






02150 Espoo (Fl) 







(54) Multiple-model navigation filter with hybrid positioning 



(57) A generalized positioning system : correspond- 
ing filter, and corresponding method, for estimating the 
state of motion of an object, the generalized positioning 
system including a measurement engine, a model se- 
lector and model bank, and a filter, which is preferably 
a statistical filter. The measurement engine is respon- 
sive to information provided by a source of range infor- 
mation, from which a measurement of the state can be 
determined, and provides a succession of measure- 
ments of the state, each corresponding to a different in- 
stant of time. The model selector and model bank se- 
lects at least one motion model for use in estimating the 
state for a segment of the motion of the object. The filter 
is responsive to the succession of measurements of the 



state, and further responsive to a model mixing param- 
eter and to the selected motion models. It determines a 
succession of multiple-model state estimates, prefera- 
bly according to the so-called interacting multiple-mod- 
el. In a further aspect of the present invention, the gen- 
eralized positioning system also includes: a weighted 
least squares (WLS) filter, responsive to each of the 
measurements in the succession of measurements of 
the state, for directly determining a succession of WLS 
state estimates; and a consistency checker, responsive 
to the WLS state estimates and to the multiple-model 
state estimates, for selecting either the WLS state esti- 
mate for an instant of time or the multiple-mode! state 
estimate, based on the multiple-model state estimate as 
well as on previous multiple-model state estimates. 



CM 
< 

CO 
CM 



CL 

LU 



Printed by Jouve, 7S001 PARIS (FR) 



BMSDOCID <EP 1 102^7A2 I > 



EP1 102 397 A2 

Description 

FIELD OF THE INVENTION 

5 [0001] The present invention relates to the field of navigation positioning systems using signals from satellites and 
cellular networks. More particularly, the present invention relates to filters that are a part of such navigation systems. 

BACKGROUND OF THE INVENTION 

10 [0002] In a global positioning system (GPS), a user's position, velocity and time (PVT) are obtained from satellite- 
to-user ranges. (It is said that the user's time is obtained to indicate that the time of transmission of the satellite-to- 
user range information, relative to the user's time, is obtained from the range signal.) By making measurements to 
more than three satellites the user's three-dimensional position can be estimated, together with the user's (three- 
dimensional) velocity. The position estimate is processed in a navigation filter, which is an essential part of a stand- 
's alone or network-assisted GPS receiver. A network-assisted GPS receiver is a GPS receiver that uses, for some of 
the filtering computation, computing facilities separate from the user, and in communication with the user's GPS receiver 
through a network, such as a cellular (telecommunications) network (NW). 

[0003] Besides using satellite-to-user ranges, a positioning system can also use range information provided by base 
stations of a cellular network, i.e. base slation-to-user ranges. Cellular ranges are obtained differently than range 

20 information in the GPS system, and only three range measurements are required to produce a user PV estimate using 
cellular ranges. At this time, positioning systems are not designed to use cellular range information, because cell 
identification reports are not yet included in signals from cellular base stations. However, the W-CDMA system, now 
under development, already has the capability to provide cell identification and thus enable cellular positioning. 
[0004] There are many ways to compute a user's PVT from range measurements, but for combined GPS and cellular 

25 positioning (hybrid positioning), the extended Kalman filter (EKF) is a suitable choice. An EKF, or a Kalman filter gen- 
erally, uses a recursive algorithm that produces an estimate of the user's PVT making use of the history of PVT meas- 
urements. A Kalman filter smoothes the sequence of measurements, so as to provide a user PVT estimate by filtering 
the measurements based on pre-defined states and models, and based on measurement noise. 
[0005] The accuracy of the user PVT estimate obtained from the Kalman filter is dictated by the states and noise 

30 levels chosen for use with the filter. A drawback of a pure Kalman filter solution is that if the states are chosen poorly, 
the outcome of the Kalman filter (KF) will not be satisfactory. In such a case it is said that the filter is inconsistent. The 
states can be selected so as to provide too great a flexibility (number of states and corresponding derivatives is too 
large) or so as to provide too little flexibility (too few states are used). 

[0006] It is hard to find a suitable set of states as well as a suitable number of states in the chosen set of states so 
35 as to provide satisfactory estimates in a large number of cases (applications). Usually, a KF-based navigation filter is 
tuned to a certain subset of all possible cases resulting in a sub-optimal solution for some cases outside of the chosen 
subset of cases. For example, a KF-based navigation filter designed and tuned for vehicles is not very suitable for 
pedestrian use or for aircraft positioning. It is consistent only for a limited set of cases. 

[0007] What is needed is a way of solving the inconsistency problem of a KF-based positioning system, i.e., of 
•to avoiding the problem of having to tune such a positioning system to one particular subset of cases. Ideally, what is 
needed is a way of adapting the subset of cases to which a KF-based positioning system is tuned so as to maintain 
consistency even if the character of the motion of the object being tracked changes significantly, i.e., what is needed 
ideally is a way to make a tuned KF-based positioning system that is robust. 

45 SUMMARY OF THE INVENTION 

[0008] Accordingly, the present invention is a generalized positioning system for estimating the state of motion of an 
object ; a corresponding filter, and a corresponding method, the generalized positioning system including: a measure- 
ment engine, responsive to range information provided by a source of range information from which a measurement 

so of the state can be determined, for providing a succession of state measurements; each measurement corresponding 
to a different instant of time; a model selector and model bank for selecting at least one motion model for use in 
estimating the state for a segment of the motion of the object; and a filter, responsive to the succession of state meas- 
urements, and further responsive to a model mixing parameter and to the selected motion models, for determining a 
succession of multiple-model estimates of the state. 

55 [0009] The filter is preferably a statistical filter, and the multiple-model state estimates are, preferably, as provided 
by the so-called interacting multiple model. 

[0010] In another aspect of the invention, the generalized positioning system also includes: a weighted least squares 
filter, also responsive to the state measurements, for directly determining a succession of weighted least squares state 
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estimates; and a consistency checker, responsive to the weighted least squares state estimates and to the multiple- 
model state estimates, for selecting either the weighted least squares state estimate for an instant of time or the multiple- 
model state estimate for the instant of time, based on the multiple-model state estimate as well as on previous multiple- 
model state estimates. 

5 [0011] In a still further aspect of the invention, the source of range information is a cellular base station, and in a still 
further aspect of the invention, the source of range information is a satellite. 

[0012] According to the method of the present invention, in estimating the state of motion of an object, the following 
steps are performed: acquiring a next state measurement in a succession of state measurements; selecting from a 
model bank (at least) two motion models for use in estimating the state for a segment of the motion of the object; 
10 determining a model mixing parameterfor combining a next state estimate according to each of the two selected motion 
models; filtering each selected motion model to provide the next state estimate according to each of the two selected 
motion models based on the next state measurement; and combining the two next state estimates according to the 
model mixing parameter to provide a next multiple-model state estimate. 

[0013] In a further aspect of the method of the invention, the following additional steps are performed: performing a 
15 weighted least squares filtering of the state measurements in parallel with the filtering of each selected motion model 
so as to directly determine a next weighted least squares state estimate from the next state measurement; and per- 
forming a consistency check, so as to be responsive to the next weighted least squares state estimate and to the next 
multiple-model state estimate, for selecting either the next weighted least squares state estimate or the next multiple- 
model slate estimate, based on the multiple-model slate estimate as well as on previous multiple-model state estimates. 

20 

BRIEF DESCRIPTION OF THE DRAWINGS 

[0014] The above and other objects, features and advantages of the invention will become apparent from a consid- 
eration of the subsequent detailed description presented in connection with accompanying drawings, in which: 

25 

Fig. 1 is a block diagram of a robust navigation filter, i.e. a fused weighted least square (WLS) filter and an interacting 
multiple-model (IMM) filter, according to the present invention; 

Fig. 2 is a flowchart of the IMM algorithm; and 

30 

Fig. 3 is a flowchart of the method of the present invention in the preferred embodiment. 
BEST MODE FOR CARRYING OUT THE INVENTION 

35 [0015] In the preferred embodiment, the present invention involves the use of a statistical filter. In the best mode, 
such a filter is a Kalman filter, including e.g. an extended Kalman filter (EKF) or other non-linear filter. Such a filter is 
said here to be "statistical" to indicate that it filters state measurements according to statistical measures involving 
current and previous state measurements, such as measurements of position or velocity or both. 
[0016] It is to be understood, however, that the present invention is not restricted to using only a Kalman filter in such 

40 a system, but instead can use any kind of statistical filter in a position-measuring system, or in a system that measures 
another aspect of the motion of an object, such as velocity, and so is here called a generalized positioning system 
(because it does not necessarily measure position), i.e. the state information provided about the object using a navi- 
gation filter according to the present invention can, in some applications, not include position, but instead can include 
only some other aspect of the motion of the object. In case of estimating position, the system may aptly be called a 

45 "positioning system , M even though it may estimate values for other aspects of the motion. But in other cases the aspect 
of the motion that is most important may be other than position; it may, for example, be angular velocity, or linear or 
angular acceleration, or simply linear velocity. In general, therefore, the present invention is for use as part of a system 
that is most aptly described as a generalized positioning system, and is to be understood to encompass estimating, in 
some applications, position, but in other applications, other aspects of motion, not necessarily including position. 

50 [0017] Further, the making of a Kalman filter or other kind of statistical filter has not been disclosed here because a 
Kalman filter and other kinds of statistical filters are known. See, e.g. U.S. Patent No. 5,902,35 1 , entitled "APPARATUS 
AND METHOD FOR TRACKING A VEHICLE," issued May 11,1 999. 

[0018] Referring now to Fig. 1 , in the best mode of the present invention, a positioning system 10 includes a heter- 
ogeneous measurement engine for receiving both satellite-to-user range information as well as cellular base station- 
55 to-user range information, from which measurements of the current state of motion of the user of the positioning system 
are determined. The measurements are provided to two modules of a robust filter 11 , one that includes an interacting 
multiple-model (IMM) module 12, and a weighted least squares (WLS) module 14, each of which compute a (usually 
different) state estimate (i.e. an estimate of position and possibly other aspects of motion such as velocity) based on 
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the measurements. Both state estimates are provided to a consistency checker 15. The consistency checker selects 
the I MM state estimate unless there is an indication of inconsistency from the estimates being produced by the IMM 
module. In such a case : the consistency checker selects the WLS state estimate. The selected state estimate, or part 
of the estimate such as only position and velocity, is then provided to an output display 22. 

5 

IMM-Based Navigation Filter 
Overview of IMM 

w [0019] Referring still to Fig. 1 , the IMM module includes a database of motion models, called a model bank, an EKF 
state estimator, and an underlying Markov chain for selecting one or another of the motion models and for controlling 
the overall model combination, i.e. the way that the predictions of tracks according to different models are combined. 
The models forming the model bank may vary greatly from each other, i.e., some might model e.g. track split processes 
while others may model time-dependent non-linear maneuvers or simply uniform linear motion. The Markov chain is 

15 defined by a fixed and pre-determined probability transition matrix M. Although only a single EKF state estimator is 
shown in Fig. 1 , if multiple tracks are combined for a segment, sometimes a different EKF estimator will be used for 
each model, as explained below. 

[0020] Referring now to Fig. 2, a flow diagram of IMM is shown, indicating that the positioning system 10 is able to 
use a combination of one or more selected models for any given segment of motion. Fig. 2 illustrates mixing only two 
20 models, based on a mixing parameter ji(k), although in principle any number of models can be mixed. In case of for 
example two models, as shown in Fig. 2, two different EKF filters can be used to each provide a state estimate according 
to a different one of the models. Sometimes, however, a single EKF filter is used to provide a state estimate for each 
model in turn. 

[0021] There are several characteristics of the IMM of advantage in the problem solved by the present invention. 
25 The IMM can change gracefully between parallel motion models, always using a combination of individual models likely 
yielding good filter consistency. The IMM is decision-free i.e., no extra logic is required to govern switching from one 
model to another. In addition, the number of motion models in an IMM application can be arbitrary, and the models 
may have very different noise levels, structures or deterministic inputs. 

30 Motion models (Model bank) 

[0022] An essential part of any tracking algorithm is the model describing the expected motion of the object whose 
PVT is being determined. In a Kalman filter-based navigation filter without IMM, only one type of motion is selected 
beforehand. The motion is modeled by the states of the filter. However, using IMM, a number of different motions can 

35 be modeled and used in parallel. 

[0023] It is natural to assume that the object using the positioning system, whether wheeled or non-wheeled, will 
occasionally maneuver, but otherwise will move with somewhat constant velocity. It is also obvious that maneuvers 
have to be compensated for so as to obtain continuous and reliable estimates of the object PVT. The better the pre- 
determined motion model or models can accommodate the behavior of the object, the more accurate will be the outcome 

40 of the tracking algorithm (navigation filter) used by the positioning system, even during periods when the positioning 
system sensors for receiving range information are blacked-out or blocked by for example obstructions. Obviously, 
should the selected models be poorly suited, the PVT estimates of the navigation filter will be poor. 
[0024] To cover a wide range of motion modes including also the static (non-moving) case, and to find out the best 
selection, the following motion model structures are selected. These can be parameterized to span even very unlikely 

45 maneuvers. 

Static Model 

[0025] In the case of a low level of process noise a*, a so-called static model is a good choice, i.e. a good choice 
50 for at least a segment of the motion of the object whose PVT is being determined. In the static model, the object is 
considered to be at rest (stopped, parked or fixed). The model consists of only five states, x =[x y z t f\ T ; all other 
states, e.g. each component of velocity or acceleration, are considered to be always equal to zero. 

Constant Speed Model 

55 

[0026] For the segments with constant speed, a model consisting of eight states is used: x ~[x x y y z z X f\ T . To make 
the filter more robust in terms of changes in speed, the following process noise covariance matrix is employed: 
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In the constant speed model, the process noise variance is set to a higher value than in the static model. 



20 



25 



Turn Model 

[0027] In the turn model, the average rate of turn (change in direction) is estimated. (The turning is considered 
rotational motion of the target with respect to a pre-determined point.) The turn model is similar to the constant speed 
model, except that the rotation rate co is included in the state vector x, and the process noise covariance matrix is 
extended by one row and one column: 




where is the process noise variance for the turn rate. One such turn model is used for both clockwise and counter- 
's clockwise turning. The turn model is well suited to modeling segments of the motion of an object when the motion 
involves fairly constant turning, e.g. cars on highway ramps. 

Colored Noise Models 

so [0028] Sometimes it is useful to assume that the motion of the object whose PVT is being determined is a correlated 
noise process (i.e. a random walk), rather than a white noise process. In such a model, the object acceleration is 
modeled as a zero-mean random process with an exponential autocorrelation function. The state vector x is considered 
to be of order 11, and in particular, x =[x x x y y y z z z t f\ T . The discrete state transition matrix for the x, y and z 
dimensions is: 

55 
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where a is the time constant defining the reciprocal duration of the motion autocorrelation. With different parameteri- 
zation of a, different kinds of motion can be modeled. The corresponding process noise covariance matrix for the case 
aT « 1 is, 
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35 where of t is the variance of the target acceleration, and Tis the sample time, i.e. the time for which the position is 
being estimated. 

Robust Filter - Navigation Filter with IMM and WLS 

40 Overview of Robust Filter 

[0029] Since any recursive navigation filter, including one using IMM, is in danger of becoming inconsistent in some 
extreme cases and yielding very poor solutions as a result, it is advantageous to have resort to a direct method in 
situations where consistency is suspect. A direct method differs from a recursive method in that it does not rely on 
45 measurement history; a direct method computes the user's P VT based only on the most current set of measurements. 
By resorting to a direct method in case of the filter becoming inconsistent, the danger is avoided that the filter will 
become biased away from the true solution because of for example a phenomenon persisting for a period of time and 
affecting the measurements used by the filter during that time. 

[0030] Among the most common and roliable direct methods is any least squares-based method, e.g. a weighted 
so least squares (WLS) method, as described below. In a navigation filter using WLS as a fallback estimator to IMM in 
case of consistency becoming suspect, a decision to switch from the IMM to instead use the WLS is based on self- 
diagnostics performed by the IMM, as described below. If the IMM is found too inconsistent with respect to the meas- 
urement innovations, the current user PVT solution is discarded and the IMM is reinitialized from the instantaneous 
WLS solution. By switching to WLS in case of potential inconsistency, unacceptable bias or even track loss can be ^ 
55 avoided. 



6 



EP1 102 397 A2 



Weighted Least Squares Solution 

[0031] In a WLS solution, each measurement is weighted to alter its importance relative to the other measurements. 
Such weighting allows taking into account the source of a measurement or indications of its quality (such as a signal 
s to noise ratio or a bit error rate). The WLS solution is given by 



Ax = [H T ( W 1 )H]" 1 H T ( W 1 )Ap , 

10 where 



15 



w = 



0 



20 



W A 



25 



is a (diagonal) weighting matrix having the measurement weight as its diagonal elements, and having the same di- 
mensionality as Ap. The weights used in the WLS solution can be chosen based on carrier-to- noise ratio, or other 
indications of the quality of the measurement to be weighted. The WLS method can also be used to estimate user 
velocity from the delta-range measurements of the GPS. 



30 



35 



40 



Self-diagnostics 

[0032] As mentioned above, even if the I MM is used with a very versatile model bank, it can become severely in- 
consistent in some cases. Before poor consistency causes track loss or severely biases the output (state estimates) 
of a navigation filter, the poor consistency should be identified and corrected. The present invention makes such an 
identification using self-diagnostics performed by the IMM. 

[0033] The IMM uses a statistical test to detect poor filter consistency. The test uses so-called measurement inno- 
vations, also called measurement residuals, defined essentially (for a statistical filter such as a Kalman filter) to be the 
difference between the value of a measurement and the expected value of the measurement, the expected value being 
based on the previous estimate by the positioning system filter. The basic idea behind the test is that there is consistency 
only so long as the measurement innovations have essentially zero mean and have a magnitude commensurate with 
the innovation covariance calculated based on the outputs by the filter. These criteria can be tested from the normalized 
innovation squared (NIS) values, yielding the time-averaged NIS statistic: 



45 



50 



55 



where the summation is over the last K(k) samples (so that K(k) can be thought of as the number of samples in a sliding 
window enclosing only the last K(k) samples), and S(k) is the measurement covariance. If the innovations are white 
(zero mean), then e^(k) is chi-square distributed, having K(k)n z degrees of freedom (where n z is the number of degrees 
of freedom of the measurement, which for only a range measurement is one, and for a combined range and Doppler 
measurement is two), and can be tested against a pre-defined acceptance interval. If at some instant of time the filter 
using IMM is detected to be inconsistent, it can be reinitialized according to the WLS solution for the instant of time. 
[0034] Fig. 3 is a flowchart of a method according to the present invention, in the preferred embodiment. 
[0035] Applying the IMM algorithm solves the inconsistency problem of a Kalman-filter based method. The IMM 
algorithm is an efficient filter frame at which the user state estimate is obtained from the proper combination of a chosen 
number of tracks computed in accordance with a corresponding same number of pre-selected motion models (state 
sets) . The simultaneous use of multiple models makes the IM M algorithm adaptable to a wide range of motion (including 
different maneuvers) and to a wide range of noise environments. The adaptability makes a navigation filter using IMM 
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inconsistent less often, i.e. either the character of the motion or the noise environment must change more for the 
navigation filter with IMM to become inconsistent. 

[0036] It should be understood, however, that the present invention comprehends using not only what is specifically 
referred to as the IMM algorithm, but using any algorithm that provides at least two motion models to a filter, i.e. any 

5 multiple-model algorithm. Moreover, it should be clear that there is no reason for restricting the filter used to filter each 
of the selected motion models to a statistical filter, such as Kalman filter. Any kind of filter could be used. In other words, 
either a statistical filter or a direct filter (i.e. a non-statistical filter) could be used in the present invention to filter a 
selected motion model, and it is even advantageous in some applications to use different kinds of filters, depending 
on the motion model. Thus, for example, any type of linear filter could be used. 

10 [0037] By fusing an IMM-based navigation filter with a WLS filter, the filter is made robust, i.e. it is much less sus- 
ceptible to inconsistency. Such a robust filter uses the IMM solution until there is an indication that the WLS solution 
should be used instead. If the IMM (filter) finds inconsistency, the current user PVT solution is eliminated and the IMM 
is restarted from the solution given by the WLS (and so based on only the most current set of measurements). The 
decision to change from using the IMM filter to using the WLS filter or to restart the IMM filter, is made by the IMM filter 

is and is based on self-diagnostics performed by the IMM filter. 

[0038] The robust filter of the present invention, a fused IMM and WLS filter, is significantly less sensitive to biased 
measurements, and much less often inconsistent. In such a filter, whenever the IMM filter cannot function satisfactorily, 
the WLS filter solutions are used to correct the IMM-based tracking. 
' [0039] It is to be understood that the above-described arrangements are only illustrative of the application of the 

20 principles of the present invention. Numerous modifications and alternative arrangements may be devised by those 
skilled in the art without departing from the spirit and scope of the present invention, and the appended claims are 
intended to cover such modifications and arrangements. 



25 Claims 

1. A generalized positioning system, for estimating the state of motion of an object, comprising: 

a) a measurement engine, responsive to range information provided by a source of range information from 
30 which a measurement of the state can be determined, for providing a succession of state measurements, each 

measurement corresponding to a different instant of time; 

b) a model selector and model bank for selecting at least one motion model for use in estimating the state for 
a segment of the motion of the object; and 

35 

c) a filter, responsive to the succession of state measurements, and further responsive to a model mixing 
parameter and to the selected motion models, for determining a succession of multiple-model estimates of 
the state. 

40 2. A generalized positioning system as in claim 1 , further comprising: 

a) a weighted least squares (WLS) filter, also responsive to the state measurements, for directly determining 
a succession of WLS state estimates; and 

45 b) a consistency checker, responsive to the WLS state estimates and to the multiple-model state estimates, 

for selecting either the WLS state estimate for an instant of time or the multiple-model state estimate for the 
instant of time, based on the multiple-model slate estimate as well as on previous multiple-model state esti- 
mates. 

so 3. a generalized positioning system as in claim 1 , wherein the source of range information is a cellular base station. 

4. A generalized positioning system as in claim 3, wherein the source of range information is a satellite. 

5. A generalized positioning system filter, for estimating the state of motion of an object, comprising: 

55 

a) a model selector and model bank for selecting at least one motion model for use in estimating the state for 
a segment of the motion of the object; and 



8 



EP 1 102 397 A2 

b) a filter, responsive to a succession of state measurements, and further responsive to a model mixing pa- 
rameter and to the selected motion models, for determining a succession of multiple-model state estimates. 

6. A generalized positioning system filter as in claim 5, further comprising: 

5 

a) a weighted least squares (WLS) filter, also responsive to the succession of state measurements, for directly 
determining a succession of WLS state estimates; and 

b) a consistency checker, responsive to the WLS state estimates and to the multiple-model state estimates, 
10 for selecting either the WLS state estimate for an instant of time or the multiple-model state estimate for the 

instant of time, based on the multiple-model state estimate as well as on previous multiple-model state esti- 
mates. 

7. A generalized positioning system filter as in claim 6, wherein the succession of state measurements is provided 
15 by a measurement engine receiving range information provided by a source of range information. 

8. A generalized positioning system filter as in claim 7, wherein the source of range information is a cellular base 
station. 

20 9. a generalized positioning system filter as in claim 8, wherein the source of range information is a satellite. 
10. A method for estimating the state of motion of an object, comprising the steps of: 

a) acquiring a next state measurement in a succession of state measurements; 



25 



b) selecting from a model bank two motion models for use in estimating the state for a segment of the motion 
of the object; 



c) determining a model mixing parameter for combining a next state estimate according to each of the two 
30 selected motion models; 



d) filtering each selected motion model to provide the next state estimate according to each of the two selected 
motion models based on the next state measurement; and 

35 e) combining the two next state estimates according to the model mixing parameter to provide a next multiple- 

model state estimate. 



1 1 . A method as in claim 1 0, further comprising the steps of: 



40 a) performing a weighted least squares (WLS) filtering of the state measurements in parallel with the filtering 

of each selected motion model so as to directly determine a next WLS state estimate from the next state 
measurement; and 

b) performing a consistency check, so as to be responsive to the next WLS state estimate and to the next 
45 multiple-model state estimate, for selecting either the next WLS state estimate or the next multiple-model state 

estimate, based on the multiple-model state estimate as well as on previous multiple-model state estimates. 

12. A method as in claim 11 , further comprising the step of acquiring range information provided by a source of range 
information from which a measurement of the state can be determined and providing the next state measurement. 



50 



13. A method as in claim 12, wherein the source of range information is a cellular base station. 



14. A method as in claim 13, wherein the source of range information is a satellite. 

15. A generalized positioning system as in claim 1 , wherein the filter is a Kalman filter. 

16. A generalized positioning system as in claim 1 , wherein the filter is a non-linear filter. 
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17. A generalized positioning system filter as in claim 5, wherein the filter is a Kalman filter. 

18. A generalized positioning system filter as in claim 5, wherein the filter is a non-linear filter. 
5 19. A method as in claim 10, wherein the filtering is as performed by a Kalman filter. 

20. A method as in claim 10, wherein the filtering is as performed by a non-linear filter. 

21. A generalized positioning system as in claim 1, wherein the succession of multiple-model estimates of the state 
10 are as provided by the interacting multiple-model (IMM) algorithm. 

22. A generalized positioning system filter as in claim 5, wherein the succession of multiple-model estimates of the 
state are as provided by the interacting multiple-model (IMM) algorithm. 

15 23. A method as in claim 1 0, wherein the next multiple-model state estimate is as provided by the interacting multiple- 
model (IMM) algorithm. 

24. A generalized positioning system as in claim 1 , wherein the filter is a statistical filter. 

20 25. A generalized positioning system as in claim 1 , wherein the filter is a linear filter. 

26. A generalized positioning system filter as in claim 5, wherein the filter is a statistical filter. 

27. A generalized positioning system filter as in claim 5, wherein the filter is a linear filter. 

25 

28. A method as in claim 10, wherein the filtering is as performed by a statistical filter. 

29. A method as in claim 10, wherein the filtering is as performed by a linear filter 

30 



35 



40 



45 



50 



55 



10 



EP 1 102 397 A2 



21b 




Heterogeneous 
measurement 
engine 



measurements 



measurements 



,11 



E 



model 



Markov Model 
Selector 



Model Bank 



model and 
measurements 



IMM 



EKF 
State Estimator 



WLS 



-14 



IMM state 
estimate 



WLS state 
estimate 



Consistency 
Checker 



-15 



22 



selected state 
estimate 

k 



Output 
Display 



FIG. 1 



11 

BNSDOCID <EP 1102397A2 I > 



EP 1 102 397 A2 



*,<*!*) 



x 2 {k\k) 





Perform 






Interaction 




Mixing 





measurements 



Filter M^k) 



Jcj(A: + l|A: + l) 



u(*l*) 



Filter M 2 (k) 



A,(*) 

x 2 (k+\\k+i) 



Perform State 

Estimate 
Combination 



A 2 (*) 



Make Model 
Probability 
Update 



Jc(* + ljA: + l) 

FIG. 2 



12 



EP 1 102 397 A2 



Acquire range information, for a next instant of time, from 
cellular base stations and satellites. 



Determine next state measurement corresponding to the 
instant of time. 



t ; 

Select from a model bank (at least) two motion models for use 
in estimating the state for a segment of the motion of the 

object. 



Determine (at least one) model mixing parameter for combining 
a next state estimate according to each of the (at least) two 
selected motion models. 



Perform statistical filtering of each selected motion model to 
provide next state estimate according to each. 



± 

Combine the two next state estimates according to the model 
mixing parameter to provide a next interacting multiple-model 
(IMM) state estimate. 



Perform a weighted least squares (WLS) filtering of the state 
measurements in parallel with the statistical filtering so as to 
directly determine a next WLS state estimate. 



Select either the IMM state estimate or the WLS state estimte 
based on a consistency check of the IMM state estimate. 
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(57) A generalized positioning system, correspond- 
ing filter, and corresponding method, for estimating the 
state of motion of an object, the generalized positioning 
system including a measurement engine, a model se- 
lector and model bank, and a filter, which is preferably 
a statistical filter. The measurement engine is respon- 
sive to information provided by a source of range infor- 
mation, from which a measurement of the state can be 
determined, and provides a succession of measure- 
ments of the state, each corresponding to a different in- 
stant of time. The model selector and model bank se- 
lects at least one motion model for use in estimating the 
state for a segment of the motion of the object. The filter 
is responsive to the succession of measurements of the 
state, and further responsive to a model mixing param- 
eter and to the selected motion models. It determines a 
succession of multiple-model state estimates, prefera- 
bly according to the so-called interacting multiple-mod- 
el. In a further aspect of the present invention, the gen- 
eralized positioning system also includes: a weighted 
least squares (WLS) filter, responsive to each of the 
measurements in the succession of measurements of 
the state, for directly determining a succession of WLS 
state estimates; and a consistency checker, responsive 
to the WLS state estimates and to the multiple-model 
state estimates, for selecting either the WLS state esti- 
mate for an instant of time or the multiple-model state 
estimate, based on the multiple-model state estimate as 
well as on previous multiple-model state estimates. 
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